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collaborative  sensing  and  exploration,  synchronized  motion  planning,  and  formation 
or  cooperative  control.  In  this  paper,  we  describe  our  recently  developed  experimen¬ 
tal  testbed  at  the  University  of  Pennsylvania,  which  consists  of  multiple,  fixed-wing 
UAVs.  We  describe  the  system  architecture,  software  and  hardware  components,  and 
overall  system  integration.  We  then  derive  high-fidelity  models  that  are  validated  with 
hardware-in-the-loop  simulations  and  actual  experiments.  Our  models  are  hybrid,  cap¬ 
turing  not  only  the  physical  dynamics  of  the  aircraft,  but  also  the  mode  switching  logic 
that  supervises  lower  level  controllers.  We  conclude  with  a  description  of  cooperative 
control  experiments  involving  two  fixed-wing  UAVs. 
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1  Introduction 


The  control  systems  community  has  historically  been  motivated  by  challenging  problems  in 
the  aerospace  industry.  Modern  aerospace  applications  call  for  increasing  levels  of  autonomy 
from  decreasing  (in  size)  aerial  and  space  vehicles,  which  are  frequently  networked. 

This  modern  view  of  future  aerospace  vehicles,  whether  civilian  or  military,  has  directed  a 
substantial  amount  of  recent  research  efforts  in  the  areas  of  interconnected  systems,  coopera¬ 
tive  control,  formation  control,  control  with  communication  constraints,  and  the  relationship 
between  dynamic  network  topologies  and  control.  The  references  cited  in  [1]— [3]  can  serve 
as  a  partial  survey  of  much  of  the  related  literature. 

The  developments  on  the  theoretical  front  have  been  followed  with  similar  achievements 
on  the  experimental  side.  However,  most  experimental  results  have  focused  on  single  aerial 
vehicles.  In  particular,  we  have  witnessed  autonomous  or  aggressive  control  of  helicopters  [4]- 
[7],  vision-based  landing  of  helicopters  [8],  blimps  [9]  and  formation  flight  of  blimps  [10]  as 
well  as  fixed  wing  planes  [11] — [14] . 

Even  though  the  theoretical  autonomous  formation  flying  (AFF)  problem  is  well  studied  [1]- 
[3],  [16] — [19] ,  the  experimental  control  of  multiple  fixed-wing  aircraft  is  in  its  infancy.  To  the 
authors’  best  knowledge,  the  only  published  experimental  results  concerning  autonomous 
formation  flying  of  autonomous  aerial  vehicles  (UAVs)  are  [20]— [24] .  In  [22]  and  [23],  the 
authors  investigate  the  benefits  of  precise  AFF  to  the  reduction  of  fuel  consumption.  In  [24] , 
the  author  attempts  AFF  for  aerial  autonomous  refueling  purposes  and/or  for  docking  a 
smaller  UAV  to  a  mother  UAV.  Other  experiments  with  UAVs  that  do  not  include  formation 
flying  and  which  concern  collision  avoidance  and  UAV  coordination  can  be  found  in  [25]  and 
[26], 

In  this  paper  which  comes  as  an  extension  to  [20] ,  we  describe  in  more  detail  the  experimen¬ 
tal  testbed  of  the  GRASP  lab  at  the  University  of  Pennsylvania,  which  consists  of  multiple, 
fixed-wing  UAVs  (Fig.  1  and  Fig.  2).  Our  testbed  has  been  rapidly  developed  by  inte¬ 
grating  of-the-shclf  solutions  for  lower  levels  of  control.  This  has  allowed  us  to  bypass  the 
typically  long  development  of  (by  now  mature)  low  level  controllers,  and  has  enabled  algo¬ 
rithm  development  and  experimentation  at  more  unexplored  higher  levels  of  UAV  planning 
and  operation,  which  include  multi-UAV  planning  and  control.  The  success  of  this  approach 
has  been  demonstrated  with  successful  AFF  experiments  and  with  successful  cooperation 
experiments  between  an  unmanned  ground  vehicle  (UGV)  and  a  PennUAV  [27]  and  [28]. 

In  Section  2,  we  describe  the  system,  software,  and  hardware  architecture  of  our  recently 
developed  testbed.  Section  3  develops  a  higher-level  hybrid  model  of  each  UAV.  Our  hy¬ 
brid  models  capture  both  high  level  abstractions  of  the  aircraft  dynamics,  as  well  as  mode 
switching  logic  that  supervises  the  switching  among  lower  level  controllers.  The  hybrid  mod¬ 
els  derived  are  used  in  high  level  algorithm  development.  The  algorithms  are  then  tested 
on  high  fidelity  (hardware-in-the-loop)  multi-UAV  simulation  environment,  described  in  Sec¬ 
tion  4,  which  contains  accurate  aerodynamic  models  of  our  UAVs.  In  Section  5,  we  present 
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the  algorithm  used  for  the  formation  flight  experiment  and  in  Section  6,  we  conclude  this 
report  with  the  actual  cooperative  control  experiments  performed  in  August  2003  at  Fort 
Benning,  Georgia. 


Figure  1:  PennUAVs:  Two  Piper  J3  cub  model  airplanes 


Figure  2:  PennUAVs:  External  Payloads  (POD) 


2  System  Description  and  Architecture 

Fig.  1  and  Fig.  2  illustrate  the  Unmanned  Aerial  Vehicles  (UAVs)  recently  developed  at  the 
GRASP  Laboratory  of  the  University  of  Pennsylvania.  Each  UAV  consists  of  an  airframe 
and  engine,  avionics  package,  onboard  laptop  and  additional  sensing  payload.  We  briefly 
describe  the  basic  components  of  our  UAVs,  as  well  as  the  overall  system  architecture. 

2.1  UAV  Airframe  and  Payload 

The  airframe  of  each  UAV  is  a  quarter  scale  Piper  Cub  J3  model  airplane  with  a  wing  span 
of  104  inches  (~  2.7  m)  (see  Fig.  1).  The  powerful  glow  fuel  engine  has  a  power  rating  of 
3.5  HP,  resulting  in  a  maximum  cruise  speed  of  60  knots  (~  30m/s)  at  altitudes  up  to  5000 
feet  (~  1500  m)  and  a  flight  duration  of  15  -  20  minutes. 
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CAMERA  IMU  EXTERNAL  POD 


Figure  3:  The  design  of  the  Camera-IMU 
Pod.  CAD  drawing  showing  the  placement 
of  the  IMU  and  the  high  resolution  camera. 


Figure  4:  The  modular  design  of  the  Pod 
allows  for  fast  production  time  using  CNC 
machines  and  for  easy  assembly. 


The  airframe-engine  combination  enables  having  significant  scientific  payload  on  board. 
Fig.  2  shows  pods  that  have  been  installed  underneath  each  side  of  the  wing  containing 
high  resolution  cameras,  IMUs,  as  well  as  deployable  sensors,  beacons,  and  landmarks.  More 
precisely,  each  UAV  can  carry  the  following  internal  and  external  payloads: 

•  Onboard  Laptop  PC  Dell  X200 

•  IMU  3DM-G  from  MicroStrain.  Includes  three  angular  rate  gyros  with  three  orthogonal 
DC  accelerometers,  three  orthogonal  magnetometers,  multiplexer,  12  bit  A/D  converter 
and  embedded  microcontroller  to  provide  the  three  orientation  angles  (pitch,  roll,  yaw) 
in  dynamic  and  static  environments. 

•  External  GPS  Navistar  GPS  receiver  from  CMC  electronics.  10  Hz  raw  data  output. 

•  Camera  DragonFly  IEEE-1394  1024  x  768  at  15  fps  from  Point  Grey  Research. 

•  Custom  designed  camera-IMU  Pod  (see  Fig.  3)  includes  the  IMU  and  the  camera 
mounted  on  the  same  plate.  The  plate  is  soft  mounted  on  four  points  inside  the  pod. 
Furthermore,  the  pan  motion  of  the  pod  can  be  controlled  through  an  external  user 
PWM  port  on  the  avionics. 

•  Custom  designed  deployable  Pod  could  be  used  to  carry  sensors,  beacons,  landmarks 
or  even  robotic  agents.  It  can  be  deployed  with  a  RC  servo  connected  to  external  user 
PWM  port  on  the  avionics.  In  the  future,  each  UAV  can  also  serve  as  a  mothership 
for  smaller,  lighter  micro-UAVs. 

2.2  UAV  Avionics  and  Ground  Station 

Each  UAV  is  controlled  by  a  highly  integrated,  user  customizable  Piccolo  avionics  board 
which  is  manufactured  by  CloudCap  Technologies  [29] — [31] .  The  avionics  board  comes 


5 


equipped  with  the  core  autopilot,  a  sensor  suite  which  includes  GPS,  Inertial  Measure¬ 
ment  Unit  consisting  of  three  gyros,  three  accelerometers  and  two  pressure  ports  one  for 
barometric  altitude  one  for  true  airspeed.  A  40  Mhz  embedded  Motorola  MPC  555  Power 
PC  receives  the  state  information  from  all  sensors  and  runs  core  autopilot  loops  at  a  rate  of 
20  Hz  commanding  the  elevator,  ailerons,  rudder  and  throttle  actuators  as  well  as  external 
user  payload  ports. 


UAV  1 


UAVn 


Ground 

Control 


Figure  5:  Multi-UAV  and  Ground  Station  Functional  Architecture 


Figure  6:  Ground  Station  Operator  Interface  showing  flight  plan  and  actual  UAV  position 
(August  2003,  Fort  Benning,  Georgia). 


2.3  System  Architecture 

Each  UAV  continuously  communicates  with  the  ground  station.  The  communication  occurs 
at  1  Hz  and  the  range  of  the  communication  can  reach  up  to  6  miles.  The  ground  station 
performs  differential  GPS  corrections,  and  updates  the  flight  plan,  which  is  a  sequence  of 
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Figure  7:  Software  Components  and  Software  Architecture. 


three  dimensional  way-points  connected  by  straight  lines.  The  UAVs  can  also  be  commanded 
in  a  similar  way  from  a  supervisory  controller  (residing  on-board  the  UAV  laptop),  allowing 
further  decentralization  in  the  physical  layer  of  the  architecture  (see  Fig.  5). 

The  ground  station  can  concurrently  monitor  up  to  10  UAVs.  Direct  communication  between 
UAVs  can  be  emulated  through  the  ground  or  using  the  local  communication  channel  on 
the  UAVs  (80211b  -  wireless  network  card).  The  ground  station  has  a  friendly  operator 
interface  program  (shown  in  Fig.  6)  which  allows  the  operator  to  monitor  flight  progress, 
obtain  telemetry  data  or  dynamically  change  the  flight  plans  using  geo-referenced  maps. 
Furthermore  the  operator  interface  program  can  act  as  a  server  and  enable  multiple  instances 
of  the  same  software  to  communicate  over  a  TCP/IP  connection.  This  allows  us  to  monitor  or 
command  and  control  the  experiment  in  real-time,  remotely.  For  an  overview  of  the  software 
architecture  see  Fig.  7.  Also  with  the  custom  interface  we  developed,  the  experiment  can  be 
visualized  in  real  time  or  offline  in  Microsoft  Flight  Simulator  with  realistic  scenery. 

2.4  Development  Philosophy 

The  integration  of  off-the-shelf  components  for  the  airframe,  engine  and  avionics  has  resulted 
in  rapid  development  and  deployment  for  each  UAV.  It  should  be  noted  that  the  assembly 
of  an  operational  UAV  is  a  matter  of  6-8  days  maximum.  This  has  also  allowed  us  to 
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quickly  experiment  with  traditionally  less-researched  areas  of  coordinated  motion  planning 
and  sensing  while  quickly  developing  the  necessary  infrastructure  in  the  more  established 
areas  of  sensing  and  control. 

3  High-Level  Hybrid  UAV  Model 

Our  goal  in  this  section,  and  one  of  the  main  goals  of  this  paper,  is  to  derive  a  hybrid 
model  of  the  Piccolo-controlled  dynamics,  coupled  with  the  mode  (or  waypoint)  switching 
logic.  Fig.  8  shows  the  main  components  that  need  to  be  modeled,  which  include  the  aircraft 
dynamics  (which  are  controlled  by  the  Piccolo  avionics  board),  a  sensor  model,  as  well  as  the 
mode  switching  logic.  We  describe  each  component  individually  and  we  model  the  integrated 
system  using  hybrid  models. 


Outputs  Inputs 


Figure  8:  Hybrid  UAV  Control  Loop. 


3.1  Piccolo-Controlled  UAV  Dynamics 

The  autopilot  in  the  Piccolo  avionics  is  responsible  for  the  low  level  control,  stabilization  and, 
also,  the  flight  plan  navigation  and  tracking  of  the  waypoints.  The  autopilot  consists  of  seven 
PID  loops  and  a  turn  compensator  (see  [29]  and  Table  1).  The  inner  control  loops  regulate, 
among  other  things,  airspeed,  altitude,  turn  rate.  The  low-level  inner  control  loops  allows  us 
to  abstract  away  lower  level,  detailed  dynamics.  The  longitudinal  dynamics  of  the  system, 
the  altitude  and  velocity  states  are  modeled  as  decoupled  first  order  differential  equations 
with  saturation  constraints.  The  simplified  equations  that  model  the  (Piccolo-)controlled 
physical  continuous  UAV  dynamics  are  as  follows: 


Autopilot  loops 


Inputs 


Airspeed 


Airspeed  from  dynamic 
pressure  port 


Altitude 
Turn  Rate 


Barometric  Altitude  from 
static  pressure  port 
Yaw  rate  from  yaw  gyro 


Tracker  (Line 
Segment) 


Position  and  track  from 
GPS  sensor 


Roll  Damper  (or 
Turn  Rate) 


Estimated  Roll  Angle 


Pitch  Damper 
Yaw  Damper 


Estimated  pitch  through 
pitch  gyro 

Yaw  rate  from  yaw  gyro 


Turn  Compen¬ 
sator 


Commanded  turn  rate  from 
tracker  loop  or  user  and 
pitch  rate  from  pitch  gyro 


Outputs 


Drives  elevator  control  surface  to  main¬ 
tain  a  commanded  dynamic  pressure 
(airspeed) 

Drives  throttle  to  maintain  com¬ 
manded  altitude 

Aileron,  rudder  control  surfaces  to 
maintain  a  commanded  turn  rate 
Drives  the  turn  rate  command  of  the 
turn  rate  loop  to  achieve  desired  track 
targets 

Lises  aileron  control  surfaces  to  damp 
roll  disturbances  and  can  be  used  as  an 
alternative  turn  rate  control 
Lises  elevator  control  surface  to  regu¬ 
late  pitch  oscillations 
Drives  rudder  control  surface  to  regu¬ 
late  yaw  oscillations 
Uses  elevator  control  surface  to  main¬ 
tain  the  target  airspeed  command  dur¬ 
ing  entering  or  exiting  turns. 


Table  1:  Autopilot  loops 


xa  =  u  cos  9 
ya  =  u  sin  9 

u  =  1/tu(-u  +  ucmd),  u  <  u  <  u  (1) 

9  =  to 

D  —  1  w  -f  wcm£j) 

Za  1/Tz(  Za  T  Zcmd)i  Z  ^  Z  ^  Z  (2) 

where  ( xa ,  ya ,  za )  is  the  position  of  the  UAV  in  the  space  with  respect  to  some  world  frame, 
u  is  the  UAV  velocity,  u  is  the  turn  rate  of  the  UAV,  and  9  is  the  angle  defined  within 
— 7T  <  9  <  7T.  External  inputs  include  ucmd,  ucmd,  and  zcm(i  where  the  subscript  cmd  defines 
controlled  inputs.  The  time  constants  are  tu,  tw,  and  rz  respectively.  Note  that  the  inner 
control  loops  result  in  abstracted  dynamics  that  decouple  the  planar  dynamics  from  the 
altitude  dynamics.  As  wind  sensors  are  available  on  board,  the  above  model  can  be  easily 
extended  to  include  (and  compensate  for)  the  effect  of  wind. 
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4  / 


(a) 


Figure  9:  Valid  flight  plans,  (a)  In  this  flight  plan,  WP  1  does  not  have  a  preceding  waypoint. 
(6)  Usual  form  of  flight  plans  for  autonomous  flight. 


3.2  Sensing  model 

The  sensors  due  to  way  the  control  laws  and  sensing  are  implemented  in  the  avionics  are 
modeled  as  a  first  order  hold  (with  delay  or  not)  where  Ts  is  the  sampling  period,  k  =  \t/Ts\ 
(where  |_-J  is  the  floor  function),  rdx,  Tdy,  Tdg  are  the  delays  and 


•i'a(f')  Xa{kT 5  Tdx) 

Va(t)  =  Va{kTs  -  Tdy ) 

u(t)  =  u(kTs )  (3) 

w(t)  =  w(kTs ) 
m  =  0(kTs-rde) 

Za(t)  =  za(kTs )  (4) 

3.3  Piccolo-High  Level  Controllers 

The  main  objective  of  the  high  level  controller  is  control  the  UAV  to  fly  a  flight  plan,  which 
is  a  sequence  of  waypoints.  The  avionics  has  the  ability  to  store  up  to  100  waypoints.  Each 
waypoint  consists  of  latitude,  longitude,  and  altitude  of  the  waypoint.  The  flight  plan  can 
be  traversed  at  various  desired  airspeeds.  Note  that  the  flight  plans  must  be  closed,  that 
is  at  some  point  a  next  waypoint  entry  of  a  waypoint  must  point  to  a  waypoint  that  it  is 
already  in  the  flight  plan  (see  Fig.  9).  Also  note  that  the  waypoints  of  the  flight  plan  that  is 
being  executed  cannot  be  altered.  Furthermore,  the  controller  has  the  capability  of  circling 
around  waypoints  (holding  pattern),  if  desired. 

The  high  level  controller  completes  the  flight  plan  by  using  one  airspeed  controller,  one 
altitude  controller,  and  two  lateral  controllers,  one  focusing  on  line  segment  tracking,  and  one 
on  circling  around  waypoints  (see  [32]).  These  controllers  are  orchestrated  by  the  waypoint 
switching  logic,  which  determines  which  waypoint  segment  is  active.  We  now  describe  the 
controllers  and  the  waypoint  switching  logic. 
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Figure  10:  Inertial  frame  model.  Xw,  Yw  is  the  world  coordinates  system,  p  is  the  previous 
waypoint,  t  is  the  target  waypoint  and  a  the  current  position  of  the  aircraft. 


Figure  11:  Tracking  a  flight  plan.  The  flight  plan  consists  of  four  waypoints  1,2, 3, 4.  The 
UAV  is  currently  tracking  line  segment  2-3 


Lateral  Controller  -  Line  segment  tracker 

The  lateral  control  law  is  trying  to  drive  to  zero  the  angle  between  the  actual  heading  of  the 
UAV  and  the  desired  heading.  The  desired  heading  is  given  by  the  position  of  the  aircraft 
xa,  the  line  segment  to  be  tracked  vkt  and  the  track  convergence  parameter  K.  In  order  to 
determine  the  desired  heading  of  the  UAV,  we  just  need  to  express  the  vector  vak  in  terms 
of  vectors  xt  and  xp  (see  Fig.  10). 


->  ->  7  %t  U* 

Vak  %t  ^Vkt  Ti  ^  ^  T 

||  'A't  | 


(5) 


i„-„  =  va,  ■  j/VVA  -  K 
||  || 


Where  xp  is  the  position  of  the  preceding  waypoint  and  xt  is  the  position  of  the  target 
waypoint.  Even  though  the  actual  coordinates  of  each  WP  as  well  as  the  position  of  the 
UAV  lie  in  M3,  for  the  lateral  control  law  we  consider  only  the  xy  plane  parallel  to  earth’s 
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plane.  Hence,  from  now  on  all  the  vectors  will  be  in  M2,  i.e.  xp,xt,xa  =  (. xa,ya )  G  M2,  unless 
we  explicitly  state  otherwise.  Finally,  K  is  the  track  convergence  parameter  (K  >  0)  and  it 
should  be  chosen  in  such  a  way  such  that  it  representative  of  the  nominal  vehicle  turn  radius 
[32]  and  [33], 

The  position  xtrack  of  the  UAV  along  the  track  (see  Fig.  11)  is  given  by  the  following 
equation: 


_  {xt  -  Xp)T(xt  -  xa) 

x  track  1 1  _*  1 1 

II  xt  ~  xp  || 

The  desired  angle  9des  for  the  UAV  is: 


(7) 


Odes  df07l2 (jjaki  -^ak)  (8) 

where  xak  and  yak  are  the  components  of  the  vector  vak  =  xak,  yak  (5).  The  error  to  be  driven 
to  zero  is: 

9e  =  Odes  ~  0  (9) 

which  is  modified  by  the  following  relations  in  order  to  keep  the  error  in  the  range  [0,  27r): 

if  0e  >  7T  then  6e  =  0des  —  0  —  2n 
if  —  tt  <  0e  <  7T  then  0e  =  0des  —  6  (10) 

if  6e  <  —tt  then  6e  =  6des  —  0  +  2tt 

The  following  P1D  control  is  used  for  the  command  input.  The  actual  implementation  of 
this  filter  is  in  discrete  time  with  integrator  antiwindup  nonlinearities  however  for  making  it 
intuitively  obvious  we  present  it  here  in  continuous  form. 

Vcmi  =  -Me  +  Ktf.  +  Ktf  O'dt  (11) 

Moreover  the  controller  bounds  the  bank  angle,  which  also  induces  bounds  on  the  control 
input  depending  on  velocity  (u)  by: 


|uw|  <  gtan<fem,‘  (12) 

u 

where  dumu  is  the  bank  limit  and  g  gravitational  acceleration. 

Lateral  Controller  -  Circle  Track 

When  the  specified  waypoint  is  a  circle  waypoint  the  UAV  circles  around  the  waypoint  at  a 
constant  radius  defined  by  the  parameter  K  [32]  until  a  new  waypoint  index  change  command 
arrives.  In  this  mode  the  outer  track  loop  simply  projects  the  current  position  of  the  UAV 
radially  on  to  the  circle  and  calculates  the  tangent  to  the  circle  at  that  point.  Then  by  simply 
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using  the  line  track  control  law  the  UAV  flies  the  line  segment  defined  by  the  projected  point 
and  the  tangent  vector.  The  xp  and  xt  vectors  get  updated  periodically  with  frequency  1  /Ts. 


V radial 


wp 


wp 


where  xwp  is  the  position  vector  of  the  waypoint  to  be  orbited. 

where  K  is  the  track  convergence  parameter. 


Xp  %wp  ~b  Kvra(nai 


xt  =  xp  + 


radial 


(13) 


(14) 


(15) 


3.4  Waypoint  Switching  Logic 

The  controllers  described  above  are  subject  to  supervisory  switching  logic.  The  switching 
logic  arises  in  two  forms.  First,  the  system  needs  to  decide  whether  the  waypoint  has  been 
reached  or  not,  and  then  reset  the  controllers  with  information  from  the  next  waypoint  in  the 
sequence.  Second,  the  user  can  dynamically  update  the  waypoints  and  the  UAV  switches  to 
the  assigned  waypoint  (WP).  In  this  case  the  UAV  makes  decisions  as  to  whether  it  should 
fly  the  old  flight  plan  or  switch  to  the  new  flight  plan. 

If  the  UAV  is  already  executing  a  flight  plan  then  it  switches  to  the  next  waypoint  when 
Xtrack  <  0  (see  Fig.  11).  For  example  assume  that  the  UAV  tracks  the  line  segment  (2-3)  - 
that  is  when  the  waypoint  index  (WPI)  has  the  value  3  and  the  preceding  waypoint  is  2 
then  when  it  flies  over  the  target  WP  3  xtrack  becomes  less  then  0  and  the  waypoint  index 
(WPI)  is  updated  to  4. 

If  the  user  or  the  supervisory  control  orders  a  new  waypoint  then  the  UAV  does  not  always 
fly  directly  to  the  new  waypoint  but  decides  its  flight  plan  according  to  the  following  logic 
(see  Fig:  12): 


1.  If  0  <  Xtrack  <||  vpt  ||  where  vpt  is  the  vector  between  the  positions  of  the  preceding 
waypoint  xp  and  the  target  waypoint  xt,  then  the  UAV  tracks  vpt  (region  1). 

2.  If  the  UAV  is  at  a  position  where  xtrack  >||  vpt  ||,  then  it  flies  directly  to  the  new 
waypoint  using  as  preceding  waypoint  its  current  position  (region  2). 

3.  If  the  UAV  is  at  a  position  where  xtrack  <  0,  then  it  flies  directly  to  the  new  waypoint 
using  as  preceding  waypoint  its  current  position  (region  3). 

4.  If  the  new  waypoint  does  not  have  a  preceding  waypoint,  then  the  UAV  flies  directly 
to  the  new  waypoint  using  as  preceding  waypoint  its  current  position.  This  is  case  (a) 
in  Fig.  9.  Note:  this  case  does  not  occur  in  autonomous  fly  as  in  this  case  all  the 
waypoints  have  preceding  waypoints. 
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region  2 


region  3 


region  1 


Figure  12:  Regions  used  in  waypoint  switching  logic 


In  our  modeling  of  the  waypoint  list  storage  unit,  we  use  an  100x6  array  where  we  store 
the  following  information  in  each  column:  (1)  x  position,  (2)  y  position,  (3)  z  position,  (4) 
next  waypoint,  (5)  preceding  waypoint  and  (6)  orbit.  The  xyz  coordinates  of  the  UAV  are 
according  to  some  fixed  world  frame. 

The  waypoints  are  numbered  from  0  to  99  and  are  used  according  to  the  following  table:  0 
to  89  free  for  the  definition  of  flight  plans  90  to  94  reserved  for  internal  use  (heading  of  the 
UAV)  95  to  99  reserved  for  the  lost  communications  flight  plan  A  flight  plan  can  include 
from  2  up  to  90  waypoints,  hence  the  avionics  can  store  up  to  45  flight  plans. 

3.5  Hybrid  Modeling 

The  hybrid  model  for  the  UAV  that  we  present  in  this  section  captures  both  the  continous 
physical  dynamics  of  the  UAV  and  the  switching  logic  that  supervises  the  lower  level  con¬ 
trollers.  The  hybrid  model,  which  is  presented  in  Fig.  13  and  Fig.  14,  uses  the  formalism 
developed  in  [34],  It  consists  of  two  concurrent  but  decoupled  hybrid  systems  with  inputs 
and  outputs,  one  modeling  the  lateral  and  one  the  altitude  dynamics.  The  lateral  dynamics 
model  consists  of  three  (discrete)  modes  of  operation  consisting  of  the  line  and  circle  track¬ 
ing  controller  described  previously,  as  well  as  a  turn  rate  controller  which  allows  the  user  to 
directly  specify  a  turn  rate.  The  altitude  controller  has  two  modes  of  operation,  one  when 
it  receives  altitude  setpoints  from  the  waypoint  list,  and  one  when  it  directly  receives  them 
from  the  user.  We  assume  that  the  transitions  are  activated  and  completed  concurrently  for 
each  transition  system. 

For  our  model,  we  will  use  the  following  notation.  Let  AR  =  [xa,  ya,  u,  6,  u]T  and  U\  = 
[ucmd,coCmd}T ,  then  AR  =  Fi(Xi,Ui)  represents  the  set  of  equations  (1).  In  the  same  way, 
let  A2  =  za,  U2  =  zcmd  and  A2  =  F2(A2,  U2)  for  (2).  We  denote  the  set  of  equations  (3)  by 
Aj  (t)  =  G'i(AA(t)).  Let  equations  (5)  to  (12)  be  represented  by  oJcmd  =  9i(xt,xp,xa,6),  and 
equations  (13)  to  (15)  be  represented  by  [xt,xp]7  =  G 2(xa,xwp). 

Some  additional  notation  is  the  following.  GtJ  is  the  guard  of  the  transition  from  the  state 
i  ( j  is  a  counter  for  the  transitions)  and  Rij  are  the  corresponding  reset  equations,  orbit  is 
a  binary  variable  denoting  whether  the  UAV  is  going  to  orbit  around  the  next  target  WP 
(NWP)  with  coordinates  xnwp.  xcwp  are  the  coordinates  of  the  current  target  WP  (CWP) 
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6||  ^11  ®16  ^16 


631  R3,  G36  ->  ft3* 


Figure  13:  Hybrid  model  of  lateral  dynamics 


77 


Figure  14:  Hybrid  model  of  altitude  dynamics 
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and  Xpwp  are  the  coordinates  of  the  previous  WP  (PWP). 

There  is  a  variety  of  events  that  trigger  transitions  in  this  hybrid  model: 

•  wpi-cmd :  command  the  UAV  to  track  a  new  WP 

•  turn_cmd\  command  the  UAV  to  start  turning  with  the  specified  turn  rate  uw  cmd 

•  alt-cmd:  UAV  changes  its  altitude  to  uait_Cmd 

•  vel-cmd :  UAV  changes  its  velocity  to  uvei_cmd 

•  altfromWP-cmd:  command  the  UAV  to  use  the  altitude  from  the  current  WP. 


Switching  from  one  mode  of  operation  to  another  can  be  directly  triggered  using  the  above 
discrete  commands.  In  addition,  switching  also  occurs  when  some  predicates  (or  guards) 
of  the  states  and  inputs  are  true.  In  the  current  framework,  we  maintain  a  set  S  with 
the  following  variables:  S  =  {xcwp,  xnwp,  xpwp,  orbit,  znwp},  where  znwp  is  the  altitude  of  the 
NWP.  This  list  represents  all  the  information  that  is  needed  by  the  UAV  in  order  to  track  a 
line  segment.  It  is  actually  an  abstraction  of  the  waypoint  list  (see  section  3.4)  used  by  the 
avionics.  The  set  S  is  updated  either  after  a  transition  has  been  taken  or  when  a  new  WP 
index  command  ( wpi.cmd )  is  received.  Note  that  this  update  could  be  modeled  as  an  extra 
state. 

In  particular,  waypoint  switching  is  based  on  a  function  that  calculates  the  position  xtrack- 
Let  this  function  to  be  f xtrack  :  M6  ^  M  (Note:  all  the  vectors  are  in  M2)  with: 


f ‘ xtrackipC a-,  X f ,  Xp ) 


{Xt-Xp)T  [xt-X  a) 

\\xt-Xp\\ 


if  xp  is  defined 


—  1  otherwise 


(16) 


In  order  to  determine  in  which  region  the  UAV  is  (see  Fig.  12  and  section  3.4),  we  have  to 
know  the  length  of  the  line  segment  to  be  tracked,  i.e.  the  length  of  the  vector  vpt .  Let  the 
function  f$pt  :  M4  — ■>  M+  U  {  — 1}  with: 

{||  xt  —  xp  ||  if  xp  is  defined 

(17) 

—  1  otherwise 

Note  that  xp  can  be  undefined  (see  case  4  in  section  3.4). 


3.6  Guards  and  reset  equations 

In  this  section,  we  are  going  to  present  in  detail  all  the  guards  and  the  reset  equations  of  the 
transitions  in  our  hybrid  model. 
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State  1  -  Line  Track  Switching  Conditions  and  Reset  Maps 

•  The  UAV  has  reached  the  switching  boundary  of  the  current  WP  — >  Switch  to  the 
next  WP  in  the  flight  plan. 

Guard: 

Gil  =  ( fxtrack{xa,xt,xp )  <  0)  A  orbit 

Reset  map: 


-till  •  %cwpi  %t  •  %nwp J 

•  Change  WP  index  command  event  ( wpi.cmd )  triggered  (and)  we  are  in  region  1  (see 
Fig.  11)  with  respect  to  the  new  line  segment  — >  Switch  to  the  commanded  WP. 

Guard: 

G 12  wpi-cmd  A  'Orbit  A  (0  A  fx  frock  ( d‘a .  %cwp •  -Epwp )  A  f  vpt  (p^cwpi  -Epwp)  ) 


Reset  map: 

Rl2  {"^P  •  •Epwpi  ■  %cwp} 

•  Change  WP  index  command  event  ( wpi-cmd )  triggered  (and)  we  are  outside  region  1 
with  respect  to  the  new  line  segment  — >  Switch  to  commanded  WP. 

Guard: 

G 1 3  Wpi-Cmd  A  ~<OTbit  A  1  (0  A  fxtrack  ( d'o,  •}  %cwpi  %pwp)  G  fvpt^cwpi  •Epwp)) 


Reset  map: 

R 13  •  -A/  ■  %t  ■  %cwp\ 

•  Turn  rate  command  event  ( turrucmd )  triggered  — >  Switch  to  state  ”  Turn  rate  track” 
(state  5). 

Guard: 

G'i4  =  turrucmd 

Reset  map: 

R\4  =  {j^cmd  -=  'U’u)_cmd\ 


•  Change  WP  index  command  event  ( wpi-cmd )  triggered  and  the  specified  WP  is  an 
orbit  — >  Switch  to  ’’Circle  track”  (state  3)  to  commanded  WP. 

Guard: 

G15  =  wpi-cmd  A  orbit 

Reset  map: 

Rl5  \ %wp  ■  cwp} 


17 


Velocity  command  event  triggered  — »  Set  velocity  input  to  commanded  velocity. 
Guard: 

G\q  =  veLcmd 


Reset  map: 


Rl6  {kernel  ■  V'vel-cmdf 


State  2  -  Altitude  from  WP 

•  WP  index  changed  either  due  to  a  command  or  to  a  switching  condition  — »  Set 
altitude  command  to  WP’s  altitude. 

Guard: 

G21  =  {Gu  V  G12  V  G13  V  G15  V  G31  V  G32  V  G33) 


Reset  map: 


R'21  \^cmd  ■  % nwp\ 


•  Altitude  command  event  ( alt-cmd )  triggered  — >  Switch  to  state  ”  Altitude  from  Com¬ 
mand”  (state  4). 

Guard: 

G22  =  altjcmd 


Reset  map: 


R22  \Zcmd  ■  crnd\ 


State  3  -  Circle  track 

•  Change  WP  index  command  event  ( wpi-cmd )  triggered  (and)  the  specihed  WP  is  an 
orbit  — »  Remain  in  ’’Circle  track”  (state  3). 

Guard: 

G31  =  wpi-cmd  A  orbit 


Reset  map: 


-*^31  \xwp  •  xcwp j 

•  Change  WP  index  command  event  triggered  (and)  the  specihed  WP  is  not  an  orbit 
(and)  we  are  in  region  1  with  respect  to  the  new  line  segment  — >  Switch  to  ’’Line 
track”  (state  1)  and  set  xt  to  commanded  WP. 

Guard: 


G32  =  wpi-cmd  A  -1 orbit  A  (0  <  fxtrack{x. 


a  5  x cwp  5  xpwp , 


</< 


Vpt  \xcwpi  xpwp 


)) 
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Reset  map: 


-*^32  \%p  •  %pwpi  %t  •  %cwp J 

•  Change  WP  index  command  event  triggered  (and)  the  specified  WP  is  not  an  orbit 
(and)  we  are  outside  region  1  with  respect  to  the  new  line  segment  — >  Switch  to  ”  Line 
track”  (state  1)  and  set  xt  to  commanded  WP. 

Guard: 

G33  =  wpi.cmd  A  -> orbit  A  -■(0  <  fxtrack(xa,  %cwpi  •Kpwp)  —  fvpt  [p^CWpi  •J'pirp)  ) 


Reset  equations  R33 : 

R33  \_%p  ■  -Ai ■  cwp } 

•  Turn  rate  command  triggered  — >  Switch  to  state  ’’turn  rate  track”  (state  5). 
Guard: 

G  34  =  turn-cmd 


Reset  map: 

R'->4  =  { f^cmd  -=  'U’u)_cmd\ 

•  Velocity  command  event  triggered  — >  Set  velocity  input  to  commanded  velocity. 
Guard: 

G33  =  vePcmd 


Reset  map: 


-P.So  { ^crncl  ■  ^vel  emdf 


State  4  -  Altitude  from  command 


•  Altitude  command  event  triggered  — >  Update  altidute  command. 
Guard: 


G41  =  alt-cmd 


Reset  map: 


Ril  \Zcmd  ■  Ualt_cmd\ 


•  Use  the  altidute  from  the  CWP  when  an  altfromWPjcmd  command  event  is  triggered 
— >  Switch  to  ”  Altitude  from  WP”  (state  2). 


Guard: 


G42  =  altfromWPjcmd 


Reset  map: 


R‘l2  {/■'crnd  •  ^ cwpj 
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State  5  -  Turn  Rate  track 


•  Turn  rate  command  event  turn_crnd  triggered  — >  Assign  new  turn  rate  command. 


Guard  <S'5 1 : 


G5 1  =  turnjcmd 


Reset  map  R^p. 


d>r)  1  { ^cmd  ■  emdf 


•  Change  WP  index  command  event  triggered  (and)  the  specified  WP  is  not  an  orbit 
(and)  we  are  in  region  1  with  respect  to  the  new  line  segment  — »  Switch  to  ’’Line 
track”  (state  1)  and  set  xt  to  commanded  WP. 

Guard: 


G5 2  =  wpi.cmd  A  orbit  A  (0  <  fxtrack(x 


ai  %cw'p')  %pwp; 


</, 


Vpt  V^cwpi  %pwp 


)) 


Reset  map: 

-R52  TCp  •  x pWp ,  Xf  .  xCWp } 

•  Change  WP  index  command  event  triggered  (and)  the  specified  WP  is  not  an  orbit 
(and)  we  are  outside  region  1  with  respect  to  the  new  line  segment  — >  Switch  to  ”  Line 
track”  (state  1)  and  set  xt  to  commanded  WP. 

Guard: 

G53  =  wpi.cmd  A  orbit  A  ->(0  <  fxtrack{xa ,  •E cwpt  •Epwp)  —  fvpt  (xcwpi  %pwp)  ) 


Reset  map: 

-R53  {Ap  •  cwp\ 

•  Change  WP  index  command  event  triggered  (and)  the  specified  WP  is  an  orbit 
Switch  to  ’’Circle  track”  (state  3)  to  commanded  WP. 

Guard: 

C54  =  wpi-cmd  A  orbit 


Reset  map: 


Velocity  command  event  triggered 
Guard: 


-R54  \XWp  .  xcwp  | 

■>  Set  velocity  input  to  commanded  velocity. 


G55  =  vel-cmd 


Reset  map: 


R55  {^cmd  ■  W'vel-cmd J 
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4  High  Fidelity  Simulation 

The  hybrid  model  developed  in  the  previous  section  will  serve  as  a  modeling  abstraction 
in  developing  high-level  algorithms  involving  multiple  UAVs.  In  order  to  implement  and 
verify  the  performance  of  algorithms  designed  using  the  hybrid  model  described  in  the  pre¬ 
vious  section,  the  designed  algorithms  are  first  executed  on  very  detailed  simulation  models 
(MATLAB  simulation  toolbox  developed  in  house).  Furthermore,  in  order  to  fully  utilize  the 
hardware-in-the-loop  (HIL)  simulator  (see  [35])  offered  with  the  Piccolo  developer’s  kit  and 
thus  attain  accurate  simulations,  it  is  mandatory  to  develop  a  high  fidelity  dynamics  model 
for  the  Piper  J3  cub  model  airplane.  This  dynamics  model  takes  into  account  aerodynamics, 
propulsion  and  inertia  effects. 

The  high  fidelity  hardware-in-the-loop  simulator  for  the  Piccolo  avionics  increases  our  confi¬ 
dence  in  the  experimental  performance  of  the  algorithms  as  it  accurately  reflects  and  predicts 
the  system  behavior  during  the  actual  flight  experiments. 

4.1  Aerodynamic  Model 

The  lack  of  publicly  available  aerodynamic  data  for  the  Piper  J3  cub  model  airplane  as  well 
as  the  modifications  done  on  the  airframe  by  the  PennUAV  team  necessitate  the  estima¬ 
tion  of  the  aerodynamic  parameters  of  the  model  airplane.  For  this  purpose,  the  vortex 
panel  method  with  boundary  layer  analysis  was  employed.  By  using  the  panel  method  for 
this  purpose  one  should  expect  overestimation  of  the  lift  and  underestimation  of  the  drag. 
CFD  tools  (such  as  solution  of  Navier-Stokes  equations)  or  wind-tunnel  tests  were  too  time 
consuming  for  the  scope  and  the  needs  of  this  research  -  at  least  at  his  point. 

The  software  toolbox  used  for  the  aerodynamic  analysis  is  presented  in  [36]  and  [37]. 
This  software  package  also  provides  tools  for  safe  store  release  prediction,  calculation  of  the 
ballistic  trajectory  of  the  store  by  solving  the  6-degree  freedom  problem  and  determination 
of  the  final  impact  point.  Thus,  it  makes  possible  the  accurate  deployment  of  any  external 
store  of  the  airplane  (i.e  the  deployable  pods  see  Fig.  2). 

The  paneling  for  the  Piper  J3  cub  model  airplane  is  presented  in  Fig.  15.  The  half  model 
(symmetric)  consists  of  1167  panels  and  the  total  computation  time  is  less  then  5 min  on 
a  Pentium  4.  All  the  tests  were  run  at  nominal  speed  ~  15m/sec  at  sea  level  standard 
(SLS)  conditions  (i.e.  a  subsonic  low  Reynolds  number  environmnet;  at  these  conditions 
Re  ~  4.2  ■  105).  The  paneling  for  the  Piper  was  designed  from  the  blue  prints  of  the  model 
airplane  taking  into  consideration  the  modifications  that  we  have  performed  on  the  frame. 
We  should  mention  that  the  wing’s  airfoil  is  not  a  standard  airfoil,  but  it  can  be  approximated 
very  well  by  a  NACA  4412.  For  simplicity,  we  chose  to  ignore  the  effects  of  the  propeller  even 
though  the  software  toolbox  supports  such  phenomena.  In  Fig.  16,  we  present  the  cl  and 
Cd  coefficients  used  in  the  hardware  in  the  loop  simulator.  Note  that  these  results  include 
the  combined  effects  of  the  fuselage  and  the  wing1. 

1For  historical  reasons,  we  would  like  to  point  the  reader  to  [38] 
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Figure  15:  The  paneling  for  the  Piper  J3  cub 


angle  (deg) 

-10.0  -5.0  0.0  5.0  10.0  15.0  20.0  25.0 


Figure  16:  The  calculated  and  modified  lift  cl  and  drag  cp  coefficients  used  in  the  H1L 
simulator  (Re  ~  4.2  •  105).  These  results  include  the  effects  of  the  fuselage  and  the  wing. 
Note  that  the  wing  has  an  incidence  of  2.44°. 

4.2  Propulsion  Model 

This  model  consists  of  the  engine  and  the  propeller  model  and  it  is  quite  simplistic  but 
comprehensive  enough  for  the  H1L  simulator.  For  this  part,  data  from  an  engine  similar  to 
the  one  actually  employed  are  used. 

4.3  Inertia  Model 

The  simple  design  of  the  Piper  J3  cub  made  possible  the  rapid  development  of  a  3D-solid 
CAD  model  (see  Fig.  17).  The  model  includes  all  skeletal  structure  of  the  airframe  with  ribs 
and  panels  and  also  all  other  significant  components  of  the  UAV  namely  PODs,  actuators, 
onboard  PC,  avionics  box  and  enclosure,  landing  gear,  fuel,  fuel  tank,  engine  and  propeller. 
From  such  a  detailed  model  one  can  easily  extract  a  very  accurate  estimate  of  the  inertia 
coefficients.  Furthermore,  the  center  of  gravity  of  the  CAD  model  was  compared  with  the 
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Figure  17:  3D-solid  CAD  model  of  the  Piper  J3  cub 


real  airframe  for  verification  and  was  found  to  be  very  accurate. 

4.4  Visualization 

The  results  of  the  high-fidelity  H1L  simulator  can  be  realistically  visualized  using  Microsoft 
Flight  Simulator ,  as  shown  in  Fig.  18.  In  addition  to  animating  simulated  trajecoties,  we 
can  also  use  the  Microsoft  Flight  Simulator  for  playing  back  actual  multi-UAV  experiments, 
which  is  the  focus  of  the  next  section. 


5  Formation  Flight  Algorithm 

Our  formation  flying  experiments  consist  of  a  leader-follower  scheme  (see  Fig.  19).  A  simple 
formation  control  algorithm  that  requires  transmition  of  minimal  information  is  used.  The 
leader  flies  a  predetermined  path  and  the  follower  tries  to  keep  the  specified  formation  using 
as  only  information  the  position  of  the  leader.  The  actual  algorithm  consists  of  a  feed¬ 
forward  outer  loop  over  the  autopilot  of  the  follower.  The  algorithm  is  actually  using  the 
turn  rate  track  (state  5)  of  our  hybrid  model.  We  consider  only  the  planar  formation  control 
problem  assuming  that  both  UAV  fly  at  predetermined  heights.  We  chose  to  ignore  the 
altitude  dynamics  even  though  the  extention  to  the  3D  formation  problem  is  straightforward 
by  adding  one  additional  outer  loop  that  accesses  state  4  of  our  hybrid  model. 

Let  the  subscript  L  to  denote  the  leader  and  F  to  denote  the  follower,  then  ft  =  (a;*,  yf)  G  M2 
is  the  position  vector  with  respect  to  the  world  frame  and  vl  is  the  ground  speed  of  UAV  i 
as  it  is  given  by  the  GPS.  The  distance  between  the  two  UAVs  is: 

d=  \/(xl-  %f)2  +  (vl  ~  Vf )2  (18) 

Let  R(6)  denote  the  rotation  matrix: 
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Center  of  mass  (mm) 

X 

287.59 

Y 

-3.07 

Z 

10.83 

Mass 

ps  10  kgr 

Table  2:  The  mass  properties  of  the  PennUAV  at  full  configuration.  The  origin  of  the 
coordinate  systen  is  at  the  engine  mount  point.  The  X  axis  points  to  the  tail  of  the  aircraft 
and  the  Z  axis  points  upwards. 


Ixx  =  1200705083.35  Ixy  =  -9381009.86  Ixz  =  80104396.63 

Iyx  =  -9381009.86  Iyy  =  938853512.70  Iyz  =  6646052.59 

Izx  =  80104396.63  Izy  =  6646052.59  Izz  =  1913020741.95 

Table  3:  The  moments  of  inertia  for  the  PennUAV  at  full  configuration  (in  gr  ■  mm2).  The 
origin  of  the  coordinate  systen  is  at  the  engine  mount  point.  The  X  axis  points  to  the  tail  of 
the  aircraft  and  the  Z  axis  points  upwards.  The  moments  of  inertia  are  given  with  respect 
to  the  center  of  gravity  of  the  aircraft  and  they  are  aligned  with  the  coordinate  system. 


Figure  18:  MS  Flight  Simulator  v isualizing  formation  control  experiment  Fort  Benning  Army 
Base  in  Georgia. 
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✓*y  desired  position  of 
s  nn  follower  for  formation 


Figure  19:  The  leader-follower  formation  flight 


_  (  cosO  sinO  \ 

=  \  - sinO  cosO  ) 

Assume  that  we  want  the  follower  to  be  at  distance  ddes  and  angle  9  with  respect  to  the 
heading  hp  of  the  leader.  Then  the  desired  position  of  the  follower  would  be: 

rdes  =  ddesR(—6)hL  (19) 

where  hjJ  =  vl/\\vl\\-  Let  Kp  6  R  be  the  parameter  of  the  potential  field,  then  the  velocity 
given  by  the  potential  field  is: 


and  the  desired  velocity: 


vp  =  Kp(fL  +  r ies  -  fF) 


(20) 


Vdes  ~  Vp  +  hpVp  pAS  (21) 

where  vl,tas  is  the  true  air  speed  of  the  leader.  Hence,  the  angle  between  the  current  heading 
of  the  follower  and  the  desired  heading  is: 


(f)  QjtCLT&fyVy^desi  ^x,des)  CCtCLTl^iVy^jr^Vx^F^)  (22) 

where  (p  G  (— 7r,  7r],  Then  the  inputs  for  the  turn  rate  track  would  be: 


nfF  —  Ku>tp 

VF,TAS  =  II  Vdes 


(23) 

(24) 


where  Ku  G  M  a  parameter. 
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6  Cooperative  Control  Experiments 

6.1  Aerial  Surveillance,  Mapping  And  Exploration 

In  this  experiment,  a  single  UAV  operating  in  autonomous  mode  executed  a  predetermined 
flight  plan  at  a  test  site  at  the  army  base  in  Fort  Benning,  Georgia.  The  UAV  flew  multiple 
passes  at  different  altitudes  over  the  target  site.  The  high  resolution  camera  was  visually 
surveying  the  ground,  while  the  100  Hz  IMU  and  the  10  Hz  GPS  collected  real  time  data  for 
further  accuracy  and  redundancy  in  generating  mosaic  maps  of  the  environment.  Fig.  20 
shows  the  generated  mosaic  map  from  images  taken  at  different  altitudes. 

6.2  Formation  Flights 

A  variety  of  formation  control  experiments  were  performed  using  two  fixed  wing  UAVs.  In 
our  cooperative  control  experiments,  two  UAVs  flew  in  formation  in  a  decentralized  manner, 
using  a  leader  follower  architecture.  The  leader  UAV  was  given  a  pre-determined  flight 
plan.  The  trajectory  of  the  follower  UAV  was  updated  once  per  second  in  real  time  through 
the  ground  station  to  keep  the  follower  at  a  fixed  distance  offset  from  the  leader.  The 
formation  control  law  we  used  is  inspired  by  the  control  law  obtained  in  [3].  Fig.  21  shows  the 
trajectories  of  the  UAVs  and  the  predetermined  flight  plan  that  was  assigned  to  the  leader. 
Marks  on  the  trajectories  represent  the  respective  positions  of  the  UAVs  every  7  seconds. 
The  winds  were  around  4  m/s  relatively  significant  with  respect  to  airspeed  (~  15 m/s)  in 
the  x  direction  (east  to  west)  at  the  time  of  the  experiment.  The  tracking  of  the  leader  UAV, 
average  deviation  from  course  on  the  upwind  leg  is  much  better  from  the  downwind  leg  due 
to  the  way  the  lateral  control  laws  were  implemented.  Another  detail  to  note  is  that  the 
tracking  behaviour  of  the  system  is  dominated  by  the  low  sampling  frequency  (1Hz)  of  the 
outer  lateral  control  loop  which  is  responsible  for  generating  turn  rate  commands.  Thus,  if 
it  is  desirable  to  achieve  tighter  formation,  the  sampling  frequency  of  the  lateral  control  loop 
has  to  be  increased  together  with  higher  performance  GPS  and  IMU  sensor  fusion. 

A  variant  of  the  previous  experiment  was  recently  conducted  where  the  follower  UAV  was 
flying  50  meters  directly  above  the  leader,  monitoring  the  UAV  below  with  a  high  resolution 
camera.  Videos  of  all  experiments  described  in  this  section  can  be  seen  in  [21]  (also  available 
on  line  at  www.grasp.upenn.edu/uav). 

7  Conclusions 

In  this  paper,  we  have  described  the  multi-UAV  testbed  developed  at  the  University  of 
Pennsylvania,  developed  a  hybrid  model  that  captures  both  abstracted  UAV  dynamics  as  well 
as  mode-switching  logic,  and  reported  on  cooperative  control  experiments  involving  two  Penn 
UAVs.  The  hybrid  model  described  in  this  paper,  which  has  been  validated  in  both  hardware- 
in-the-loop  simulations  and  actual  experiments,  will  serve  as  modeling  abstraction  and  will  be 
utilized  in  applying  hybrid  control  methods  in  order  to  solve  challenging  problems  involving 
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Figure  20:  Aerial  Surveillance  Experiment  -  Generated  Mosaic  Image  (Aug.  14th  2003,  Fort 
Bcnning,  Georgia) 


Figure  21:  Autonomous  Formation  Experiment  1  (Aug.  14th  2003,  Fort  Benning,  Georgia, 
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Figure  22:  Autonomous  Formation  Experiment  1  (Aug.  14th  2003,  Fort  Benning,  Georgia, 


multiple  UAVs,  such  as  synchronous  or  asynchronous  formations,  coordinated  search  and 
rescue,  air-ground  integration,  and  rapid  emergency  response. 
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